/**
 * @file common.c
 * @brief 
 * @author LiWanglin (lwl510ll@163.com)
 * @version 1.0
 * @date 2024-08-18
 * 
 * @copyright Copyright (c) 2024  LiWanglin
 * 
 * @par 修改日志:
 * <table>
 * <tr><th>Date       <th>Version <th>Author  <th>Description
 * <tr><td>2024-08-18 <td>1.0     <td>wangh     <td>内容
 * </table>
 */

#include <math.h>
#include "common.h"

/**
 * @brief 对弧度进行归一化处理，限定在[0,2*PI]之间
 * @param  angle: 需要归一化的弧度
 * @return 归一化后的弧度
 */
float NormalizeAngle(float angle)
{
    angle = fmod(angle, 2 * PI);

    return angle >= 0 ? angle : (angle + 2 * PI);
}